00001
00002 PhysicsServer PhysicsServer::_instance;
00003
00004
00005 PhysicsServer::PhysicsServer() : _world(0),
00006 _space(0),
00007 _contactgroup(0),
00008 _envSpace(0),
00009 _ground(0)
00010 {
00011 }
00012
00013
00014 PhysicsServer::~PhysicsServer()
00015 {
00016 shutdown();
00017 }
00018
00019
00020 bool PhysicsServer::init(int groundSizeX, int groundSizeY)
00021 {
00022 if (groundSizeX <= 20 || groundSizeY <= 20)
00023 return false;
00024
00025
00026 _world = dWorldCreate();
00027
00028
00029 _space = dHashSpaceCreate(0);
00030
00031
00032 _contactgroup = dJointGroupCreate (0);
00033
00034 _envData.slip = 0.15;
00035
00036
00037
00038 dWorldSetGravity (_world,0,0,-(PHYS_GRAVITY*PHYS_MASS_SCALE));
00039 dWorldSetERP (_world, 0.6);
00040
00041
00042 _envSpace = dSimpleSpaceCreate(_space);
00043 _ground = dCreatePlane (_envSpace,0, 0, 1, 0);
00044 dGeomSetData(_ground, (void*)&_envData);
00045
00046
00047
00048 return true;
00049 }
00050
00051
00052 void PhysicsServer::shutdown()
00053 {
00054
00055 _clientList.clear();
00056
00057
00058 if(_contactgroup)
00059 {
00060 dJointGroupDestroy (_contactgroup);
00061 _contactgroup = NULL;
00062 }
00063
00064 if (_space)
00065 {
00066 dSpaceDestroy (_space);
00067 _space = NULL;
00068 }
00069
00070 if (_world)
00071 {
00072 dWorldDestroy (_world);
00073 _world = NULL;
00074 }
00075 }
00076
00077
00078
00079 bool PhysicsServer::registerClient(PhysicsClient* client)
00080 {
00081 if (client == NULL)
00082 return false;
00083
00084
00085 bool success = client->init(_world, _space, _envSpace );
00086
00087 if (success)
00088 _clientList.push_back(client);
00089
00090 return success;
00091 }
00092
00093
00094 void PhysicsServer::collisionCallback (void *data, dGeomID o1, dGeomID o2)
00095 {
00096
00097 if(data!=NULL){
00098 PhysicsServer* serverPtr = (PhysicsServer*)data;
00099 serverPtr->checkCollision(serverPtr, o1, o2);
00100 }
00101 }
00102
00103
00104
00105 void PhysicsServer::checkCollision(void *data, dGeomID o1, dGeomID o2)
00106 {
00107 int i,n;
00108 if( dGeomIsSpace( o1 ) || dGeomIsSpace( o2 ) )
00109 {
00110 dSpaceCollide2( o1, o2, data, &collisionCallback );
00111 }
00112 else
00113 {
00114 int mode = 0;
00115 double slip1 = 0;
00116 double slip2 = 0;
00117
00118
00119 dBodyID body1 = dGeomGetBody(o1);
00120 dBodyID body2 = dGeomGetBody(o2);
00121
00122 PhysGeomData* pData1 = (PhysGeomData*)dGeomGetData(o1);
00123 PhysGeomData* pData2 = (PhysGeomData*)dGeomGetData(o2);
00124
00125
00126 if (pData1 != NULL)
00127 slip1 = pData1->slip;
00128
00129 if (pData2 != NULL)
00130 slip2 = pData2->slip;
00131
00132
00133 if (slip1 != 0)
00134 mode |= dContactSlip1;
00135
00136 if (slip2 != 0)
00137 mode |= dContactSlip2;
00138
00139 static const int N = 8;
00140 dContact contact[N];
00141 n = dCollide (o1,o2,N,&contact[0].geom,sizeof(dContact));
00142 if (n > 0)
00143 {
00144
00145 if(!(o1==_ground||o2==_ground)){
00146 vector <PhysicsClient*>::const_iterator iter = _clientList.begin();
00147 vector <PhysicsClient*>::const_iterator iter2;
00148 dGeomID first,second;
00149 int i=0;
00150 for(;iter != _clientList.end();iter++)
00151 {
00152 for(iter2=iter+1;iter2 != _clientList.end();iter2++)
00153 {
00154 first=(*iter)->getGeomID();
00155 second=(*iter2)->getGeomID();
00156 if(o1==first && o2==second)
00157 {
00158
00159
00160 (*iter)->setCollusion();
00161 (*iter2)->setCollusion();
00162
00163
00164 int j;
00165 int size=crashedGeomIds.size();
00166 for(j=0;j<size;j++)
00167 {
00168 if(crashedGeomIds.at(j) == first)
00169 break;
00170
00171 }
00172
00173 if(j == size)
00174 {
00175 crashedGeomIds.push_back(first);
00176 crashedGeomIds.push_back(second);
00177
00178 alSourcePlay(sound_id);
00179
00180 }
00181 i=1;
00182 }
00183 if(i==1) break;
00184 }
00185 if(i==1) break;
00186 }
00187 }
00188
00189 for (i=0; i<n; i++)
00190 {
00191 contact[i].surface.mode = mode;
00192 contact[i].surface.mu = dInfinity;
00193 contact[i].surface.slip1 = slip1;
00194 contact[i].surface.slip2 = slip2;
00195
00196 dJointID c = dJointCreateContact (_world, _contactgroup, &contact[i]);
00197 dJointAttach (c, body1, body2);
00198 }
00199 }
00200 }
00201
00202 }
00203
00204
00205
00206 bool PhysicsServer::update(double step)
00207 {
00208 if (_world == 0 || _space == 0)
00209 return false;
00210
00211 dSpaceCollide (_space, this, &collisionCallback);
00212
00213 vector <PhysicsClient*>::const_iterator iter = _clientList.begin();
00214 double speed;
00215 while(iter != _clientList.end() )
00216 {
00217
00218 speed=(*iter)->update(step);
00219 iter++;
00220 }
00221
00222
00223 dWorldStep (_world, step);
00224
00225
00226 dJointGroupEmpty (_contactgroup);
00227
00228 return true;
00229 }
00230
00231 void PhysicsServer::setCrashId(int soundId)
00232 {
00233 sound_id = soundId;
00234 }